"REMARK *************************"
"REMARK COSC 4P78 - EXPERIMENT 6"
"REMARK MASHAAL A. MEMON 1802370"
"REMARK WASINTARA THAWESAWAT 1937614"
"REMARK PICK UP BLOCK FROM CONVEYOR BELT"
"REMARK *************************"
"SPEED 215"
"MOVE UP"
"MOVE UPSTART"
"REMARK WAITING FOR BLOCK TO PASS BY FIRST SENSOR "
"WAIT 1"
"MOVE UPTRY"
"OPENI 70"
"MOVE DOWNTRY"
"REMARK TRY TO GRASP THE MOVING BLOCK"
"GRASP 10, 1"
"REMARK IF GRASPED, DROP BLOCK AT DROP POINT"
"GOTO 2"
"REMARK IF BLOCK WAS MISSED, WAIT FOR BLOCK TO HIT SECOND SENSOR"
"1 MOVE UPTRY"
"WAIT 2"
"REMARK GRASP THE BLOCK AT SECOND SENSOR AND DROP AND DROP POINT"
"MOVE UPSTOP"
"OPENI 70"
"MOVE DOWNSTOP"
"CLOSEI"
"2 MOVE UPTRY"
"MOVE UP"
"REMARK LEAVE BLOCK AT DROP POINT"
"MOVE DROPPOINT"
"OPENI 60"
"REMARK MOVE BACK TO HOME"
"MOVE UP"
"CLOSEI"
"MOVE P0"
-
"P0" 127.7405  0  88.02699 -90.0002  0 
"UP" 117.6994  0  208.8152 -98.68849  0 
"UPSTART" 254.7489 -189.6717  277.4343 -90.0002 -36.6693 
"UPTRY" 223.7659  69.32789  233.7433 -87.65202  1.246525 
"DOWNTRY" 242.1357  75.01927  204.8026 -87.65202  1.246525 
"DOWNSTOP" 272.56  195.1322  223.216 -82.01636  11.41345 
"UPSTOP" 248.8296  178.1431  255.9449 -81.78154  11.41344 
"A" 152.591  47.27626  175.3772 -87.65202  1.246525 
"DROPPOINT" 129.4069  86.52021  127.2302 -90.0002  33.76631 
